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Autonomous space rendezvous scenarios require knowledge of the target vehicle state 
in order to safely dock with the chaser vehicle. Ideally, the target vehicle state information 
is derived from telemetered data, or with the use of known tracking points on the target 
vehicle. However, if the target vehicle is non-cooperative and does not have the ability 
to maintain attitude control, or transmit attitude knowledge, the docking becomes more 
challenging. This work presents a nonlinear approach for estimating the body rates of a 
non-cooperative target vehicle, and coupling this estimation to a tracking control scheme. 
The approach is tested with the robotic servicing mission concept for the Hubble Space 
Telescope (HST). Such a mission would not only require estimates of the HST attitude and 
rates, but also precision control to achieve the desired rate and maintain the orientation 
to successfully dock with HST. 


I. INTRODUCTION 

Vehicles designed to rendezvous and dock with existing space missions are being considered for a number 
of scenarios. In-space assembly is considered a fundamental requirement to accomplish space exploration 
goals. 1,2 ‘Space Tug’ concepts are being designed to provide servicing and refuelling for in-flight missions. 3,4 
Kimura, et al present a demonstration mission for on-orbit maintenance of satellites. 5 In 2004 former 
NASA Administrator Sean O’Keefe asked the Hubble Space Telescope (HST) program to investigate robotic 
servicing of the HST to extend the science life. 6 In all cases, the chase vehicle must have knowledge of the 
target vehicle state and must perform precise control in order to safely dock with the target vehicle. When 
the target vehicle is non-cooperative, meeting the knowledge and control requirements becomes much more 
challenging. 

This work applies an approach to estimate the attitude and rates of a non-cooperative target vehicle, and 
then uses the attitude and rate estimates as the desired state of the chase vehicle tracking control algorithm. 
The target vehicle attitude estimate is assumed to be provided by a vision or feature-based sensor. The 
target rate is determined with the nonlinear estimation approach presented in reference 7. The estimator is 
exponentially stable in the absence of any measurement errors, and remains robust to bounded perturbations 
resulting from uncertainties in the measured target attitude. The estimator provides the desired rate for the 
nonlinear passivity-based control scheme presented in reference 8. The nonlinear controller is asymptotically 
stable in the absence of any disturbances. The actual attitude of the chase vehicle is assumed to be available 
from an accurate sensor such as a star tracker. The chase vehicle rates are provided by calibrated gyros. 

The stability of the nonlinear control algorithm, given bounded estimates of the desired state of the chase 
vehicle, is explored through simulations. We consider the effects of additional error sources, such as second 
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to here as the Hubble Robotic Vehicle (HRV), is used as the test scenario. The HRV must be capable of 
docking with HST, regardless of the orientation or rotation rate of HST, including the scenario in which the 
HST batteries have died and HST is tumbling. 

The next section gives an overview of the mathematical terms. Then the nonlinear estimation algorithm 
is summarized, followed by a summary of the nonlinear control algorithm. We then present the results of 
several scenarios, applied to the HST-HRV mission concept. Finally conclusions are given along with future 
considerations. 


II, Attitude and Angular Rate Definitions 


The attitude of a spacecraft can be represented by a quaternion, consisting of a rotation angle and unit 
rotation vector e, known as the Euler axis, and a rotation <j> about this axis so that 9 
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where q is the quaternion, partitioned into a vector part, e, and a scalar part, 77 , The target attitude quater- 
nion is designated as q t7 which defines the rotation from inertial to the target spacecraft body coordinates. 
The chase vehicle attitude quaternion is designated as q c . 

The rotation, or attitude, matrix can be computed from the quaternion components as 9 


R — R(q) = (if — e T e)ls + 2ee T — 2rjS (e) 


where I3 is a 3x3 identity matrix and S(s) is a matrix representation of the vector cross product operation. 
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Note also that R(q)e = e. The derivative of R(q) is given as 9 


R(q) = —S(u>)R(q) 


where w is the angular velocity in body coordinates. 

A relative rotation between coordinate frames is computed as 10 


Qrel 


€ 

= Q\® < 7 2 1 = 

7)2! — S(s2) —£2 

e 1 

. % . 


£2 V 2 



( 1 ) 


( 2 ) 


Using the definition given in equation 2 , the relative attitude quaternion from the chase vehicle body coor- 
dinates to the target body coordinates is then 

Qct = Qt ® H 1 (3) 


The angular velocity of the target vehicle body coordinates with respect to inertial space, resolved in 
target body coordinates, is designated as cj t . Similarly the angular velocity of the chase vehicle in chase 
vehicle body coordinates is designated as to c . 


III. Target Vehicle Nonlinear Angular Velocity Estimator 

The angular velocity estimator is intended for the scenario in which the target vehicle is non-cooperative. 
For example, in the HST robotic servicing mission the estimator would be used in the event that the HST 
batteries have died and no telemetry is available from HST. The chase vehicle is equipped with an accurate 
quaternion star tracker, which provides g c , and a sensor system which produces a measurement of the relative 
quaternion, q ct . The unknown target vehicle angular velocity is estimated in the inertial coordinate system 
through the estimation of the target vehicle inertial angular momentum. The target vehicle angular velocity 
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in body coordinates is computed by a transformation of the inertial angular velocity. The development and 
stability analysis of the algorithm are provided in reference 7. The algorithm is summarized here. 

The system equations consist of the kinematic equation for the target vehicle attitude quaternion and 
Euler’s equation for the target vehicle given in inertial coordinates 

9t = | 0 (g t )wt = \Q{q t ) R tUi,t = I Q(q t )it lR t h i,t 

hi,t — 'Ii t t 

where I t is the target vehicle inertia matrix in body coordinates, assumed to be constant. Note that 
U,t = B^ItRu where I^ t is the inertia matrix in inertial coordinates and R t is the target vehicle attitude 
matrix defining the transformation from inertial to target body coordinates. Ti f t is the external torque acting 
on the target vehicle, resolved in inertial coordinates, and 
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where, by inspection, Qi(q t ) = rjth + S(e t ). 

The predicted target vehicle quaternion as defined as 
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The attitude error is defined as the relative orientation between the predicted attitude q t and the measured 
attitude, q u computed from equation 2 from the measured relative attitude quaternion and the measured 
chase vehicle attitude quaternion. The estimator attitude error is 
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The state estimators for the HST attitude and angular momentum are defined as 

= \Q(qt)R(qt) T [ir lR tKt + fce t sign(%)] 
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( 6 ) 


hi, t = At + I t 1 £tsign(i7t) (7) 

The term R(q t ) T in equation 6 transforms the angular velocity terms from the body frame to the predicted 
attitude frame. The gain k is chosen as a positive constant. Similarly, the learning rate, /?, is also a positive 
constant. Essentially, q t is a prediction of the attitude at time t, propagated with the kinematic equation 
using the estimated angular momentum. 

The error equations are given as 

ht = lQ(q t )(lr lR thi,t - I^Rthi.t - k£ t s\ga{fjt)) ( 8 ) 

Let hi t t = hi,t — hi jt . The derivative of h^t is 

hi,t = (9) 

Note that the equilibrium states for 8 and 9 are 

[ hit ]= [ 0 0 0 ±1 0 0 0 ] 

In the absence of any errors, equations 8 and 9 are exponentially stable, i.e u> £ — > u? t exponentially fast. 7 
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Reference 7 examines the stability of the nonlinear estimator given errors in the relative attitude quater- 
nion. The measurement of the relative attitude quaternion from the vision and feature based sensor was 
the largest source of error for HRV. When the true quaternion is unknown, equations 6 and 7 cannot be 
implemented. Instead, the erroneous measured attitude q t rn is used in place of q t7 resulting in 

4t = + fce t , TO agn(?}t,m)] (10) 
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Tij is the estimated external torque. The estimator, however, remains robust to disturbances in the relative 
attitude measurement. The addition of a leakage term ensures that the system remains bounded in the event 
of unusually large disturbances. 


IV. Chase Vehicle Control Algorithm 

Prior to docking with the target vehicle, the chase vehicle control system must force the chase vehicle to 
match the attitude and attitude rates of the target vehicle to within some mission specific tolerance. In the 
non-cooperative scenario considered here, the target vehicle attitude and rates are provided by the nonlinear 
estimator of the previous section. The chase vehicle is equipped with star trackers and calibrated gyros 
to provide the necessary feedback signals to the control algorithm. In this work we consider the nonlinear 
adaptive controller of reference 8. 

The attitude dynamics of the chase vehicle, modelled as a rigid spacecraft, are given as (the time depen- 
dence is omitted for clarity) 

I c &c ~~ S(I c u> c + h c )cv c = u + h c 

where I c is the inertia matrix, u is the applied external torque, u c is the angular velocity, and h c is the wheel 
momentum in body coordinates. The goal of the control law is to force the attitude of the chase vehicle, q c 
to asymptotically track the target vehicle attitude, q ti and the target vehicle rate, u; t . The attitude tracking 
error is computed with equation 2 as 


= Qc ® Qt 1 

The rate tracking error is given as 

Cb tc - - R(Qtc)“t 

where R{q tc ) transforms the angular velocity from the target vehicle body frame to the chase vehicle body 
frame. 

The control law is given as 

xl -j- h c —— — j FC j^s(t) T I c cx r S{I c u c + ho)t*J r 
Kd is any symmetric, positive definite matrix and s is an error defined as 

$ = &tc + Ae tc =c uj c - oj t 

where A is any positive constant. The reference angular velocity u> r is computed as 

u r - R(.Qtc)u t - Aeto 



The derivative of co r is given as 


«r = w r = R(q tc )u t - S(&tc)R(q t c)“i ~ A<3i(g ct )d? l0 

Asymptotically perfect tracking is obtained with the above control scheme, given noise free measurements 
of the states cj c and q c . Reference 11 also shows that the control scheme is robust to gyro bias errors and 
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bounded noise disturbances. (The gyros are assumed to be calibrated for scale factor and misalignment 
errors prior to the approach and capture phase. Gyro bias errors can be estimated a priori as well.) 

In a typical control application the desired states are well defined. In this work, however, the desired 
states are estimated with the nonlinear estimator outlined in the previous section. The nonlinear estimator 
provides continuous estimates of the desired attitude, desired rate, and derivative of the desired rate. The 
desired attitude is provided by the estimator as q t . The control error is then computed as 

= <7 C ® Qt 1 

The desired rate, w t in the target body coordinates, is computed from the estimated angular momentum as 

w t = I^R(q t )hi it 

The chase vehicle desired angular acceleration, in the target body coordinates, is then 

<■ W =-ir 1 [R{Gt)hi,f+ R(q t )ht] 

Substituting for R(q t ) from equation 1 and h itt from equation 11, d> t is written as 
U>t = If 1 [S(& t )R(§ t )h il t +R(q t )(f i ,t + 

where £t t m> Wt,m, and Rt,m are all calculated using the measured attitude. The goal is to demonstrate that 
the control algorithm will asymptotically track the estimated- states, which are bounded estimates of the 
true states in the presence of measurement errors. 

V. Simulation Results 

The algorithms outlined in the previous sections are tested in two simulation environments. Both sim- 
ulations are based on an HRV-HST rendezvous scenario. The first simulation is developed in Matlab. The 
Matlab simulation gives a high level indication of the performance of the combined estimator and control 
algorithm. Then the simulation is developed in the NASA Goddard Space Flight Center simulation environ- 
ment known as Freespace (FSP). FSP is a C-based high performance, simulation environment. FSP utilizes 
shared memory with a modular environment which allows for simultaneous processing and visualization. 
The results from the Matlab simulation are presented first, followed by results from FSP. 

The HST (target) inertia is 12 
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The HRV (chase) inertia matrix is 12 
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The HST truth model simulation includes aerodynamic torque and gravity gradient torque with second order 
effects. 13 ’ 14 

The HST attitude measurements are simulated by rotating the true HST attitude by a random angle 
about a random unit direction. The random angle is generated from a zero mean, normal distribution, the 
random unit direction is generated from a zero mean, uniform distribution. The standard deviation of the 
random angle is first set at 5 degrees, after approximately 30000 seconds the standard deviation is reduced to 
1 degree. The vision sensors are expected to improve as the separation between the vehicles decreases. The 
estimator is initialized with the first attitude measurement. The HRV attitude is initialized at q c — [0,1, 0, 0]. 
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The initial HRV angular velocity is a> c — [0, 0, 0] deg/sec. The HST truth model is initialized with a random 
attitude, and a random initial angular velocity, generated with a zero mean, normal distribution with a 
standard deviation of 0.07 deg/sec/axis. 

Figures 1 through 4 shows the true attitude control error and the angular velocity control error for each 
axis for 100 test cases. Each case contains a different initial random attitude and rate in the HST truth 
model, and different random measured attitudes. The top plot of each figure shows the convergence once 
the controller is started at 5000 seconds. The bottom plot shows the steady state behavior. The final 




Figure 1. True Attitude Control, Transient and Steady State Errors 



Figure 2. True X Axis Angular Velocity Control Errors, Transient and Steady State 
average attitude control error for all 100 cases is 0.37 deg. The final average angular velocity control error 
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Next, the algorithms are tested in the FSP high fidelity simulator. The Freespace truth model contains 
gravity gradient and aerodynamic external torques acting on both HST and HRV. The HRV gravity gradient 
torques are input to the control algorithm as a feed forward torque. The scenario developed for these results 
places the HRV at the 50m hold point on the HST -VI axis (boresight axis), which is the point at which the 
rescue mission would have begun to match the attitude and angular rate of HST for docking. 

The estimator performance in Freespace compares to the results in reference 7, though with a longer 
convergence time. The attitude of HRV is initially controlled using a coarse attitude control with no roll 
constraint, until 15000 sec (4 h, 10 min) when the target attitude tracking controller is enabled. Figures 5 
and 6 show the magnitude of the true attitude control error and the true angular rate error. The magnitudes 
of the attitude control error converge to 0.02 deg at the end but vary as high as 0.15 deg. The rate error does 
not have as much variation and converges to 2.8 x 10~ 5 deg/sec. Next, sensor noise is added to the relative 
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Figure 5. True Attitude Control Errors from Freespace, No Measurement Errors 
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Figure 6. True Rate Control Errors from Freespace, No Measurement Errors 
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quaternion measurement by corrupting the true relative attitude measurement with a randomly generated 
quaternion with a 3<r magnitude of 10 deg. Figure 7 shows the magnitude of the true attitude controller 
error, which converges to 0.75 deg, with only slight variations above 1 deg. Figure 8 shows the convergence 
of the true angular rate error, which converges to 0.00091 deg/sec. For a relative quaternion measmement 
with only 1 deg of error, the controller attitude and rate errors converge to 0.075 deg and 0.0024 deg/sec, 
respectively. 


True Control Error Magnitude between HST and HRV 



Figure 7. True Attitude Control Errors from Ereespace, 10 deg Measurement Error 
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Figure 8. True Rate Control Errors from Freespace, 10 deg Measurement Error 


These results confirm the findings of the low fidelity MATLAB simulation, and also enable further 
experiments to characterize the estimator / controller interaction and behavior under various conditions 
(i.e. varying the measurement error, the initial target rates, and dynamic model fidelity). 

VI. Conclusions 

An approach for estimating the attitude and rates of a non-cooperative target vehicle and then controlling 
the chase vehicle to match the estimated attitude and rates is presented. The attitude and rates are estimated 
with a nonlinear estimation algorithm that is robust to measured attitude errors. The nonlinear control 
algorithm is asymptotically stable in the absence of errors, and remains robust given gyro measurement 
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errors. The algorithms are applied to the proposed HST robotic servicing mission and are tested first with 
a Matlab simulation which includes random attitude measurements and random initial conditions. A Monte 
Carlo simulation demonstrates that the combined algorithms are stable and converge to less than 0.4 deg and 
0.01 deg/sec in attitude and rate control errors (magnitude), respectively. The algorithms are then tested in 
a high performance simulation environment known as Freespace. Again, the combined algorithms are stable 
and converge to final errors less than 0.075 deg and 0.0024 deg/sec. 

Future work will expand the simulation scenario in Freespace. The vision sensors will be modelled and 
used to provide the relative attitude measurement. Additional fidelity will be added to the wheel models and 
the chase vehicle gyros, along with a star tracker based attitude estimation algorithm for the chase vehicle. 
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